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A  METHOD  OF  REDUCING  RANDOM  DRIFT  IN  THE 


COMBINED  SIGNAL  OF  AN  ARRAY  OF  INERTIAL  SENSORS 

STATEMENT  OF  GOVERNMENT  INTEREST 
[0001]  The  invention  described  herein  may  be  manufactured  and 
used  by  or  for  the  Government  of  the  United  States  of  America 
for  governmental  purposes  without  the  payment  of  any  royalties 
thereon  or  therefore. 

CROSS  REFERENCE  TO  OTHER  PATENT  APPLICATIONS 
[0002]  None . 

BACKGROUND  OF  THE  INVENTION 
(1)  Field  of  the  Invention 

[0003]  The  present  invention  relates  to  the  components  of 
inertial  measurement  units,  sensors  such  as  gyroscopes  and 
accelerometers.  More  particularly,  the  invention  relates  to  a 
method  to  calculate  optimal  weights  for  use  in  combining  the 
signals  from  an  array  of  gyroscopes  or  accelerometers  into  a 
single,  low-drift  signal  to  improve  the  resonant  sensor  bias 
stability  relative  to  a  single  gyroscope  or  accelerometer. 
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(2)  Description  of  the  Prior  Art 

[0004]  Gyroscopes  and  accelerometers  are  necessary  components 
of  inertial  measurement  units  (IMUs),  which  are  used  for  the 
guidance  and  stabilization  of  many  platforms.  The  performance 
of  a  rate  gyroscope  or  accelerometer  is  influenced  by  a  number 
of  factors  including  scale-factor  errors,  quantization  effects, 
temperature  effects,  random  drift,  and  additive  noise.  A 
comprehensive  account  of  all  of  these  influencing  factors  for 
gyroscopes  has  been  established  in  a  standard  published  by  the 
Institute  for  Electrical  and  Electronics  Engineers  (IEEE). 

Among  the  many  possible  noise  sources  identified  in  the  IEEE 
standard,  the  additive  noise  and  random  drift  are  often  the 
dominant  sources.  This  is  true  of  tactical-grade 
microelectromechanical  systems  (MEMS)  sensors,  which  are  of 
interest  for  use  in  tactical  IMUs. 

[0005]  In  an  array  of  multiple  inertial  sensors,  such  as  an 
array  of  MEMS  gyroscopes,  the  goal  is  to  combine  the  multiple 
sensor  outputs  without  a  loss  of  accuracy  associated  with  the 
in-run  bias  stability  of  the  sensors.  There  exist  prior  art 
methods  of  combining  the  outputs  of  the  array  of  sensors  to 
improve  the  bias  stability  of  the  collective  output,  Bayard  et 
al,  US  Patent  6,882,964.  The  prior  art  methods  rely  upon  the 
use  of  Kalman  filtering  and  averaging.  These  prior  art  methods 
tend  to  be  time  consuming  and  processor  intensive. 
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[0006]  The  approach  of  the  present  invention  is  to  exploit 
the  correlations  in  the  statistical  properties  of  one  sensor  to 
another.  Among  the  dominant  noise  sources,  the  additive  noise 
terms  for  different  sensors  are  uncorrelated,  however,  there  may 
be  correlations  between  the  random  drift  of  different  sensors. 
The  method  of  the  present  invention  is  to  estimate  these 
correlations  from  a  finite  amount  of  calibration  data  in  order 
to  calculate  coefficients  for  the  optimal  linear  combination  of 
multiple  sensor  signals.  The  method  of  the  present  invention 
relies  on  a  prior  art  method  developed  by  the  present  inventors 
described  in  an  article  published  in  IEEE  Transactions  on 
Instrumentation  and  Measurement,  Volume  61,  Issue  3,  Pages  673- 
684,  06  February  2012,  entitled:  " Statistical  Modeling  of  Rate 
Gyros".  The  method  of  the  present  invention  is  a  means  of 
combining  multiple  sensor  outputs  to  obtain  a  virtual  sensor 
signal  with  reduced  drift,  and  in  a  far  more  computationally 
efficient  and  less  processor  intensive  way  than  the  prior  art. 

SUMMARY  OF  THE  INVENTION 

[0007]  Accordingly,  it  is  an  object  of  the  present  invention 
to  provide  a  method  to  estimate  the  correlations  between  drift 
components  of  different  sensors  from  a  finite  amount  of 
calibration  data. 
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[0008] 


Another  object  of  the  present  invention  is  to  derive 


an  optimal  coefficient  vector  to  weight  the  output  signal  vector 
of  an  array  of  inertial  sensors  such  as  gyroscopes  to  create  an 
optimal  linear  combination  of  signals. 

[0009]  In  accordance  with  the  method  of  the  present 
invention,  an  array  of  multiple  gyroscopes  is  modeled 
mathematically.  The  output  signal  vector  of  the  array  is 
represented  as  the  weighted  sum  of  the  vector  of  true  rate 
signals,  the  vector  of  the  gyroscope  biases  (random  drift)  and 
an  observation  noise  vector.  The  gyroscope  biases  and  noise 
vectors  are  modeled  using  spectral  density  matrices  Q  and  R. 

The  spectral  densities  are  estimated  using  statistical 
estimation  theory  and  Allan  covariance  statistics. 

Specifically,  the  off-diagonal  terms  of  the  spectral  density 
matrix  Q  for  the  random  drift  component  of  the  array  of 
gyroscopes  are  estimated.  This  estimate  is  then  used  to  derive 
an  optimal  coefficient  vector  to  weight  the  output  signal  vector 
of  the  array  of  gyroscopes  to  create  an  optimal  linear 
combination  of  signals  into  a  single  virtual  signal. 

BRIEF  DESCRIPTION  OF  THE  DRAWINGS 
[0010]  Other  objects,  features  and  advantages  of  the  present 
invention  will  become  apparent  upon  reference  to  the  following 
description  of  the  preferred  embodiments  and  to  the  drawings. 
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wherein  corresponding  reference  characters  and  elements  indicate 
corresponding  parts  throughout  the  several  views  of  the  drawings 
and  wherein: 

[0011]  FIG.  1  is  a  block  diagram  of  an  inertial  measurement 
unit  that  implements  the  method  of  the  present  invention  by 
combining  an  array  of  multiple  inertial  sensors  in  a  manner  that 
reduces  the  random  drift  in  the  combined  signals  of  the  array. 

DETAILED  DESCRIPTION  OF  THE  INVENTION 
[0012]  The  present  invention  is  a  method  of  combining 
multiple  sensor  outputs  from  an  array  of  inertial  sensors. 
Referring  to  FIG.  1  there  is  illustrated  an  inertial  measurement 
unit  10  that  consists  of  the  following  components:  an  array  of  N 
inertial  sensors  12,  an  electronic  data  gathering  card  16  joined 
to  the  array  of  N  inertial  sensors  12,  and  an  electronic  digital 
processor  18  joined  to  the  data  gathering  card  16.  In  a 
preferred  embodiment  the  inertial  sensors  12  are  tactical-grade 
microelectromechanical  systems  (MEMS)  3  axes  orthogonal 
accelerometers  or  3  axes  orthogonal  gyroscopes.  Each  inertial 
sensor  12  in  the  array  generates  a  signal  14  that  is  received  by 
the  data  gathering  card  16.  In  a  preferred  embodiment,  the  data 
gathering  card  16  will  have  data  storage  capability  and  be 
capable  of  performing  analog  to  digital  conversion  or  digital  to 
analog  conversion  depending  upon  the  type  of  inertial  sensor  12 
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used.  The  digital  processor  18  can  be  a  microcontroller  and 
will  be  programmed  to  receive  data  from  the  data  gathering  card 
16  and  implement  the  linear  combination  of  sensor  signals  14 
through  the  method  of  the  present  invention. 

[0013]  The  first  step  in  the  method  is  to  mathematically 
model  the  array  of  inertial  sensors  12.  For  purposes  of 
illustration  the  sensors  will  be  referred  to  as  gyroscopes  in 
the  following  description  of  the  method.  In  order  to  model  an 
array  of  gyroscopes  12  it  suffices  to  jointly  model  two 
gyroscopes  by  estimating  the  correlation  properties  between  the 
two  gyroscopes  as  well  as  their  individual  statistical 
properties.  This  can  then  be  done  for  an  array  of  any  number  of 
gyroscopes  by  modeling  all  pairwise  combinations  of  gyroscopes. 
The  output  signal  vector,  y(t),  of  a  two  gyroscope  array  is 
described  by  the  following  equation: 

y  ( t )  =  co  ( t )  +  b(t)  +  n(t)  (1) 

where  co(t)  is  a  vector  of  true  rate  signals  14,  (wherein  col  (t) 
is  the  signal  14  from  inertial  sensor  (1)  and  co2  (t)  is  the 
signal  14  from  inertial  sensor  (2)  and  co(t)=  [col  (t)  co2(t)]T,  b(t) 
is  a  vector  of  gyroscope  biases,  and  n(t)  is  an  observation 
noise  vector.  In  the  absence  of  motion,  the  true  rate  is  zero 
and  the  gyroscope  output  signal  consists  of  bias  plus  noise. 

The  bias  term  b(t)  is  a  vector  of  rate  random  walks  or  RRW,  and 


6  of  10 


the  additive  noise  term  n(t)  is  a  vector  of  angle  random  walks 
or  ARW. 


[0014]  The  next  step  is  to  model  the  statistical  properties 
of  the  bias  vector  and  noise  vector  with  spectral  density 
matrices.  The  elements  of  the  noise  vector  n(t)  are  modeled  as 
statistically  independent  bandlimited  white  noise  processes  with 
spectral  densities  R\  and  Ri,  respectively,  and  common  bandwidth 
B  Hz.  The  spectral  density  matrix  of  n(t),  R,  is  expressed  as 
follows : 


R  = 


Rt  0 
0  R2 


(2: 


The  spectral  density  matrix  of  b(t)  is  a  random  walk  arising 
from  w(t),  a  vector  white-noise  process  with  a  spectral  density 


matrix  Q  expressed  as  follows: 

E[w(t1)w(t2)]  =  -  t2),Q  = 


Q ii  Q 12 

VQl2  Q22J 


o: 


[0015] 


The  next  step  is  to  estimate  the  nonzero  elements  of  R 


and  Q  of  the  additive  noise  and  random  drift  components  of  the 
gyroscope  signals.  The  matrix  R  is  a  diagonal  matrix  consisting 
of  the  spectral  densities  of  the  additive  noise  components  of 
the  individual  gyroscopes.  These  and  the  diagonal  elements  of  Q 
can  be  obtained  by  modeling  each  gyroscope  individually.  The 
modeling  of  an  individual  gyroscope  is  as  follows: 


(4: 
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where  H  is  a  known  Nxp  matrix,  a[m]  is  a  vector  of  Allan 


variance  statistics  corresponding  to  a  set  of  points  m,  C  is  the 
sum  of  the  covariance  matrices  of  a[m ]  for  the  ARW  and  RRW  terms 
expressed  as 

C  =  CR(m,R0)+  CQ(m,Q  0)  (5) 


and  where 


H  = 


(2 ]-2T)/3 


V(2  J- 


-r) 


(6) 


[0016]  The  matrix  Q  is  not  diagonal.  Estimates  of  Q±±  and  Q22 
are  obtained  jointly  with  R\  and  Ri  when  modeling  individual 
gyroscopes.  The  off-diagonal  elements,  however,  are  computed  by 
jointly  modeling  a  pair  of  gyroscopes.  The  steps  for  estimating 
the  off-diagonal  elements  of  the  Q  matrix  (Q12)  are  as  follows. 
Define  the  Allan  covariance  (a  technigue  to  estimate  the  rate 
random  walk  of  two  sensors  Q12)  matrix  for  a  smoothing  interval 
of  m  samples  to  be  A[m ]  for  all  mem  where  m  =  [2,  4,  ...  2n] 
expressed  as  follows: 

A[m]  =  ics=i)£"=i(zfc+i  ~z^zk+1  -zky  (7) 

Where  Zk  are  averages  of  length  m  segments  of  non-overlapping 
gyroscope  output  data  14. 
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[0017] 


For  an  array  of  g  gyroscopes,  the  Allan  covariance 


matrix  A\m\  is  a  g  x  g  symmetric  matrix.  The  off-diagonal  terms, 
2lij[m]  i  =£  j  are  the  Allan  covariances  between  gyroscope  i  and 
gyroscope  j.  Estimate  the  individual  gyroscope  statistics  Rk  and 
Qk k,  k  =  1,  ...,  g.  Let  a  be  the  vector  whose  elements  are  Aj[m] 
for  all  mem.  Let  H=(T/3)m.  Calculate  the  covariance  matrix 

C  =  CR  ( m ,  Ru  Rj )  +  CQ  (m,  Qu  Qj  O)  ( 8 ) 

Estimate  the  off  diagonal  terms  Q,j  of  the  spectral  density  matrix 
Q  as  follows : 

Qij  =  (9) 

[0018]  Once  the  spectral  density  matrix  Q  is  determined,  the 
next  step  is  to  generate  a  combined  stabilized  inertial  sensor 
output  signal  in  the  form  of  a  single  scalar  virtual  gyroscope 
signal  20,  v(t),  whose  RRW  spectral  density  is  Qv  by  taking  a 

fixed  linear  combination  of  the  gyroscope  signals  14  collected 
in  vector  y(t)  with  the  use  of  a  coefficient  vector  c,  which 
gives  the  optimal  linear  combination  of  gyroscope  outputs.  The 
virtual  gyroscope  signal  20,  v(t)  ,  is  expressed  as: 

v(t)  =  c*  y(t)  =  J  ( co  ( t )  +  b(t)  +  n  ( t )  )  Eq.  (10) 
where  the  coefficient  vector  c  =  [Ci...Cg]T  satisfies 

oTc  =  1,  with  o  =  [1  ...  1]  T  (11) 
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Each  gyroscope  is  measuring  the  same  velocity  signal  co(t)  .  The 


constraint  implies  that  the  weighted  signal  components  in 
each  of  the  gyroscope  signals  14  will  add  up  to  co(t)  . 

[0019]  The  virtual  gyroscope  signal  20,  v (t)  ,  is  modeled  as 
the  output  of  a  single  gyroscope  employing  the  RRW  spectral 
density  matrix  Qv: 

Qv  =  cTQc  (12) 

When  the  coefficient  vector  is  optimal 


the  model  becomes: 


wherein  no  other  fixed  linear  combination  of  gyroscope  signals 
14  can  have  an  RRW  spectral  density  lower  than  Qv* .  The  virtual 
signal  20  is  intended  for  use  as  control  data  in  the  guidance 
system  of  a  vehicle,  for  navigation  or  for  the  stabilization  of 
a  platform. 


[0020]  It  will  be  understood  that  many  additional  changes  in 
the  details,  materials,  steps  and  arrangement  of  parts,  which 
have  been  herein  described  and  illustrated  in  order  to  explain 
the  nature  of  the  invention,  may  be  made  by  those  skilled  in  the 
art  within  the  principle  and  scope  of  the  expressed  in  the 
appended  claims. 
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A  METHOD  OF  REDUCING  RANDOM  DRIFT  IN  THE 
COMBINED  SIGNAL  OF  AN  ARRAY  OF  INERTIAL  SENSORS 

ABSTRACT  OF  THE  DISCLOSURE 

The  disclosed  invention  provides  a  method  that  exploits  the 
correlations  in  the  statistical  properties  of  one  inertial 
sensor  to  another.  Among  the  dominant  noise  sources,  the 
additive  noise  terms  for  different  sensors  are  uncorrelated, 
however,  there  may  be  correlations  between  the  random  drift  of 
different  sensors.  The  method  of  the  present  invention 
estimates  these  correlations  from  a  finite  amount  of  calibration 
data  in  order  to  calculate  coefficients  for  the  optimal  linear 
combination  of  multiple  sensor  signals.  The  method  is  a  means 
of  combining  the  multiple  sensor  outputs  to  obtain  a  virtual 
sensor  signal  with  reduced  drift,  and  in  a  far  more  time 
efficient  and  less  processor  intensive  way  than  the  prior  art. 
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